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(54) Vehicle attitude angle estimation using sensed signal blending 

(57) An attitude angle estimator and method of esti- 
mating attitude angle of a vehicle. According to one 
embodiment, an angular attitude rate sensor (12) 
senses angular attitude rate (13) of a vehicle, and an 
accelerometer (14) detects lateral or longitudinal accel- 
eration (15). An attitude angle estimate (82) is produced 
and is updated as a function of the sensed angular atti- 
tude rate (13). An acceleration-based attitude angle 
(88) is determined as a function of the sensed acceler- 
ation (15), and a blending coefficient (92) is provided. A 
current vehicle attitude angle estimate (82) is generated 
as a function of the updated attitude angle estimate 
(82), the acceleration-based attitude angle (88), and the 
blending coefficient (92). According to a second embod- 
iment, both a roll angle estimate (82) and a pitch angle 
estimate (84) are determined. 



CM 
< 

o 

CM 

o 
o 



Q. 
LU 



Primed by Xerox (UK) Business Services 
2.16.7 (HRS)/3.6 



1 



EP 1 002 709 A2 



2 



Description 

Bagkgrpund of the Inventign 

[0001] The present invention generally relates to 5 
vehicle attitude angle sensing, and more particularly, to 
low-cost roll and pitch angle estimation for a vehicle. 
[0002] Future generation automotive vehicles may 
increasingly employ safety-related devices that deploy 
in the event that the vehicle rolls over to provide added 10 
protection to the occupants of the vehicle. For example, 
upon detecting a vehicle rollover condition, a pop-up roll 
bar can be deployed such that, when activated, the roll 
bar further extends vertically outward to increase the 
height of support provided by the roll bar. Other control- is 
table features may include actuating deployment of one 
or more air bags, such as front or side deployment air 
bags, or actuating a pretensioner to pretension a 
restraining device, such as a seat belt or safety harness, 
to prevent occupants of the vehicle from ejecting from 20 
the vehicle or colliding with the roof of the vehicle. 
[0003] In the past, basic rollover sensors have been 
employed in automotive vehicles to measure the angu- 
lar position of the vehicle from which a rollover condition 
can be determined. The basic rollover sensors have 25 
included the use of a pendulum normally hanging verti- 
cally downward due to the earth's gravitational force. 
Many basic automotive sensing devices are employed 
simply to monitor the angular position of the vehicle rel- 
ative to a level ground horizontal position. 30 
As a consequence, the basic automotive vehicle rollover 
sensors have generally been susceptible to error when 
the vehicle travels around a turn or becomes airborne, 
in which case the earth's gravitational force, which the 
sensor relies on, may be overcome by other forces. ss 
[0004] More recently, sophisticated rollover sensing 
approaches have been considered. One such approach 
considered requires the use of six sensors including 
three accelerometers and three angular rate sensors, 
also referred to as gyros, all of which are employed 40 
together for use in an inertial navigation system which 
tracks position and attitude of the vehicle. The three 
accelerometers generally provide lateral, longitudinal, 
and vertical acceleration measurements of the vehicle, 
while the three gyros measure pitch rate, roll rate, and 45 
yaw rate. In sensing a rollover condition, the system 
determines a vehicle roll angle. However, the more 
sophisticated conventional rollover sensing approaches 
generally require a large number of high-precision and 
expensive sensors. In addition, known sophisticated so 
systems are susceptible to cumulative drift errors, and 
therefore must be reset occasionally. 
[0005] It should be appreciated that various other 
applications may require knowledge of the roll and pitch 
attitude angles of a vehicle as the vehicle maneuvers on 55 
the ground. In addition to rollover detection, attitude 
angle estimators may be employed to provide a roll and 
pitch angle indications to the driver or other occupants 



of the vehicle. In the past, attitude angle estimators 
have employed one or more accelerometers and an 
angular rate sensor for each axis of rotation of the vehi- 
cle. However, there exists the problem of how to com- 
bine angle-related information contained in the 
accelerometer and angular rate sensor in order to 
obtain an overall attitude angle measurement. This is 
because each type of sensor generally has characteris- 
tic failings in the conventional applications. 
For example, the accelerometer-based attitude angle 
estimate is generally relatively noisy when the vehicle is 
traveling on a rough road surface, and may sustain large 
errors whenever the vehicle's trajectory involves an iner- 
tial acceleration having a component perpendicular to 
the rotational axis under consideration. In addition, the 
angular rate sensor estimate, which is typically obtained 
by integrating the angular rate sensor's output signal, 
generally has a tendency to drift with an ever-increasing 
error due to unknown bias or offset in the sensed angu- 
lar rate signal. 

[0006] It is, therefore, one object of the present 
invention to provide for an attitude angle estimator that 
provides an estimation of the attitude angle of a vehicle 
and minimizes errors that may be present in automo- 
tive-grade sensors. It is another object of the present 
invention to provide for an attitude angle estimator that 
combines vehicle sensed signals to obtain an overall 
more accurate attitude angle estimation. It is a further 
object of the present invention to provide for a vehicle 
roll angle estimator and/or vehicle pitch angle estimator 
that minimizes the effects of noise present in an accel- 
erometer based angle estimate, and minimizes error 
present in an angular rate sensed signal. 

Summary of the Invention 

[0007] In accordance with the teachings of the 
present invention, an attitude angle estimator and 
method of estimating attitude angle of a vehicle are pro- 
vided for estimating the roll and/or pitch angle. The atti- 
tude angle estimator employs an angular attitude rate 
sensor for sensing angular attitude rate of a vehicle and 
producing an output signal, and an accelerometer for 
detecting lateral or longitudinal acceleration of the vehi- 
cle and producing an output signal. A controller deter- 
mines an acceleration-based attitude angle as a 
function of the sensed acceleration. 
The controller determines an attitude angle estimate 
and updates the attitude angle estimate as a function of 
the angular attitude rate. The controller further provides 
a blending coefficient and further updates the attitude 
angle estimate so as to generate a current vehicle atti- 
tude angle estimate as a function of the acceleration- 
based attitude angle and the blending coefficient, and 
produces a vehicle angle estimate signal, such as a roll 
angle estimate and/or a pitch angle estimate. 
[0008] The method for estimating an attitude angle 
of a vehicle according to the present invention includes 
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sensing angular attitude rate of a vehicle and producing 
an output signal, and sensing a lateral or longitudinal 
acceleration of the vehicle and producing an output sig- 
nal. The method also includes determining an accelera- 
tion-based attitude angle as a function of the sensed 5 
acceleration. An attitude angle estimate is provided and 
is updated as a function of the angular attitude rate. A 
blending coefficient is also provided. The method fur- 
ther updates the attitude angle estimate to generate a 
current vehicle attitude angle estimate as a function of 70 
the acceleration-based attitude angle and the blending 
coefficient. The vehicle attitude angle estimate may 
include a roll angle estimate and/or a pitch angle esti- 
mate. 

[0009] These and other features, advantages and is 
objects of the present invention will be further under- 
stood and appreciated by those skilled in the art by ref- 
erence to the following specification, claims and 
appended drawings. 

20 

Brief Description of the Drawings 

[0010] In the drawings: 

FIQ. 1 is a block diagram of an attitude angle esti- 25 
mator/rollover sensing module for estimating vehi- 
cle roll angle and pitch angle according to the 
present invention, and for further redicting vehicle 
rollover and pitchover; 

FIQ. 2 is a block diagram illustrating a single-axis so 
roll angle estimator for estimating a roll angle of a 
vehicle according to one embodiment of the 
present invention; 

FIGS. 3A and 3B are block diagrams illustrating a 
dual-axes angle estimator for estimating roll and 35 
pitch angles of a vehicle according to a second 
embodiment of the present invention; and 
FIGS. 4A-4C are flow diagrams illustrating a meth- 
odology for estimating the roll and pitch angles of a 
vehicle according to the second embodiment of the 40 
present invention. 

Detailed Description of the Preferred Embodiments 

[0011] Referring to FIG. 1, a vehicle angle estima- 45 
tor/rollover sensing module 10 is illustrated for use in 
sensing vehicle attitude angular rate and acceleration 
dynamics, estimating angular roll and pitch angles, and 
predicting a rollover and/or pitchover condition of an 
automotive vehicle (not shown). The sensing module 10 so 
of the present invention is preferably mounted on an 
automotive vehicle and used to estimate the roll and/or 
pitch attitude angles, and may further predict future roll- 
over and pitchover conditions of the vehicle, according 
to the example shown. The attitude angle estimation ss 
may include a roll angle estimation which is the angular 
side-to-side rotation about the vehicle's longitudinal 
axis, or a pitch angle estimation which is a front-to-back 



angular rotation about the vehicle's lateral axis, or may 
be used to determine both roil and pitch angle estima- 
tions. A vehicle rollover condition, as described herein in 
connection with the present invention, may include side- 
to-side rotation of the vehicle about the vehicle's longitu- 
dinal axis, commonly referred to as a 'Vehicle rollover," 
and back-to-front rotation about the vehicle's lateral 
axis, commonly referred to as a "vehicle pitchover, " or a 
combination of rollover and pitchover. For purposes of 
describing the rollover sensing of the resent invention, 
the term "rollover" is generally used to refer to either a 
rollover condition or a pitchover condition. 
[0012] The sensing module 10 is designed to be 
located in an automotive vehicle to sense vehicle 
dynamics, estimate roll and pitch attitude angles, and 
predict rollover or pitchover conditions of the vehicle. 
Upon predicting a vehicle rollover or pitchover condition, 
the sensing module 10 may provide an output signal 
indicative of the predicted rollover or pitchover condi- 
tion. The rollover or pitchover condition output signal 
may be supplied to one or more selected vehicle 
devices, such as safety-related devices, to actuate the 
selected devices in anticipation of an upcoming rollover 
event. The predicted rollover or pitchover condition out- 
put signal may be employed to deploy a pop-up roll bar 
to provide extended lateral support to the occupants of 
the vehicle just prior to the actual vehicle rollover occur- 
ring. Similarly, the predicted rollover or pitchover condi- 
tion output signal may actuate an occupant restraining 
device, such as a seat belt or safety harness preten- 
sioner to eliminate slack in the restraining device just 
prior to the vehicle rollover occurring. Other controlled 
functions include deployment of front and/or side 
deployment air bags to protect the vehicle occupants 
during a vehicle rollover. These and other devices may 
be controlled in response to the rollover condition output 
signal. 

[0013] The sensing module 10 shown herein 
includes six sensors, all preferably assembled together 
on module 10, and oriented to perform the intended 
sensing operation. The sensors include a roll angular 
rate sensor 12, a pitch angular rate sensor 16, a lateral 
accelerometer 14, a longitudinal accelerometer 18, a 
vertical accelerometer 20, and a yaw angular rate sen- 
sor 25. The roll angular rate sensor 12 measures the 
time rate of angular roll 13 about the vehicle's longitudi- 
nal axis, while the pitch rate sensor 16 measures the 
time rate of angular pitch 17 about the vehicle's lateral 
axis. 

The lateral accelerometer 14 measures acceleration 15 
of the vehicle along the vehicle's lateral axis. The longi- 
tudinal accelerometer 18 measures acceleration 19 of 
the vehicle along the vehicle's longitudinal axis. The ver- 
tical accelerometer 20 measures the acceleration 21 of 
the vehicle along the vehicle's vertical axis. The yaw 
angular rate sensor 25 measures the yaw rate 27 about 
the vertical axis of the vehicle. 
[0014] The sensing module 10 further includes a 
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microprocessor control unit (MCU) 22 for processing 
sensed vehicle parameters according to an attitude 
angle estimator algorithm, and may further include a 
rollover sensing algorithm to predict vehicle rollover and 
pitchover conditions. MCU 22 is preferably a microproc- 
essor-based controller and, according to one example, 
may include Model No. HC12 made available by 
Motorola. Associated with MCU 22 is an electrically 
erasable programmable read-only memory (EEPROM) 
24 that stores various programmed calibrations for per- 
forming the attitude angle estimator algorithm as is 
explained hereinafter, and may further store pro- 
grammed calibrations for the rollover sensing algorithm. 
The EEPROM 24 can be integrated with the MCU 22 or 
provided external thereto. Sensing module 10 further 
includes a power and communication interface 26 for 
receiving an ignition IGN1 signal on line 28 and commu- 
nicating via serial data (SDATA) on serial data bus 32. 
Sensing module 10 is further grounded via ground line 
30. Power and communication interface 26 converts an 
approximately 12 -volt DC IGN1 signal input to 5-voits 
DC for use as a power supply to the components on 
module 10. Serial data communicated on data bus 32 
may include individual sensor outputs and processor 
outputs as well as programmed inputs. 
[0015] MCU 22 receives, as inputs, signals from 
each of sensors 12, 14, 16, 18, 20, and 25. In addition, 
the MCU 22 receives other various inputs that may be 
employed in connection with the attitude angle estima- 
tion and rollover and pitchover predicting of the present 
invention. These inputs may include a vehicle speed 
sensor (VSS) signal 34 indicative of the speed of the 
vehicle and auxiliary left and right wheel position sen- 
sors (WPL) and (WPR) signals 36 and 38 for providing 
an indication of whether the wheels on either the left or 
right side of the vehicle are not in contact with the 
ground. The auxiliary wheel position sensors signals 36 
and 38 are wheel position measurements taken relative 
to the body of the vehicle. Other inputs include a pas- 
senger presence (PPS) signal 40, which may be gener- 
ated as a sensed output from an occupant presence 
sensor for purposes of sensing the presence of a pas- 
senger. A driver's seat belt (DSB) signal 44 and a pas- 
senger's seat belt (PSB) signal 46 indicate the use of 
driver and passenger seat belts, respectively. Also pro- 
vided is a steering wheel angle (SWA) signal 42 for pro- 
viding an indication of the current vehicle steering wheel 
angle relative to the longitudinal axis of the vehicle. 
[001 6] MCU 22 processes the various input signals 
and produces output signals identified as ROLLOVER 
signal 50 and PITCHOVER signal 52, which are indica- 
tive of a predicted vehicle rollover condition and a pre- 
dicted pitchover condition, respectively. In addition, 
MCU 22 provides the predicted rollover and pitchover 
output signals on line 62 to control designated onboard 
control devices, such as a seat belt reeler control 54, a 
lap seat belt pretensioner control 56, and a seat belt 
retractor control 60. Seat belt reeler control 54 controls 
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the seat belt reeler for both the driver's side and passen- 
ger's side via respective signals DREL and PREL as 
provided on output line 64 and 66, respectively. Seat 
belt pretensioner control 56 likewise controls seat belt 

5 pretensioning for the driver's side and passenger's side 
via signals DPRET and PPRET as provided on output 
lines 68 and 70, respectively. A diagnostic current 
source and sink 58 allows for diagnostic testing of the 
seat belt reeler control 54 and seat belt pretensioner 56. 

w The seat belt retractor control 60 controls retractor locks 
associated with the seat belt to both the driver's seat 
belt and passenger's seat belt via signals DRET and 
PRET, as provided on output lines 72 and 74. 
[0017] According to the present invention, MCU 22 

15 processes the various input signals and produces atti- 
tude angle output signals identified as roll angle esti- 
mate signal 82 and pitch angle estimate signal 84, 
which are indicative of an estimated vehicle roll and 
pitch angles, respectively. The estimated roll and pitch 

20 angle output signals 82 and 84 may be output to a dis- 
play for displaying the current estimated roll and pitch 
angles of the vehicle for viewing by the vehicle occu- 
pants. The estimated roll and pitch angles 82 and 84 
can be used to produce the rollover and pitchover sig- 

25 nals 50 and 52. Examples of rollover sensing modules 
for predicting vehicle rollover and pitchover conditions of 
a vehicle are disclosed in U.S. Patent Application No. 
09/020,140, entitled "Vehicle Rollover Sensing," U.S. 
Patent Application No. 09/019,878, entitled Vehicle 

30 Rollover Sensing Using Extended Kalman Filter," and 
U.S. Patent Application No. 09/020.137, entitled "Vehi- 
cle Rollover Sensing Using Short-term Integration," all 
of which were filed on February 6, 1998. The disclosure 
of each of the aforementioned patent applications are 

35 hereby incorporated by reference. While an example of 
rollover and pitchover sensing is provided herein, it 
should be appreciated that the roll and pitch angle esti- 
mator and method of the present invention may be 
employed for various other applications. 

40 [0018] The vehicle attitude angle estimation of the 
present invention derives an angle estimate from one or 
more accelerometers, and combines the acceleration- 
based angle estimate with the angular rate signals to 
obtain a overall angle estimate. This may include provid- 
es ing for either a roll angle estimate or a pitch angle esti- 
mate, or a combination of roll and pitch angle estimates. 
It should be appreciated that the method for obtaining 
the accelerometer-based angle estimate may vary with 
the number and configuration of accelerometers that 

so are available, as well as the availability of other external 
signals, such as vehicle speed and yaw rate signals. 
Two embodiments for estimating attitude angles for sin- 
gle-axis (roll or pitch) and dual-axes (roil and pitch) of a 
vehicle are provided in FIGS. 2 and 3, and are explained 

55 hereinafter. 

[0019] Referring to FIG. 2, implementation of a sin- 
gle-axis roll angle estimator 80 is illustrated therein for 
estimating the roll angle by sensing the roll rate signal 
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13 and the lateral acceleration signal 15 generated by 
roll angular rate sensor 12 and lateral accelerometer 14, 
respectively. Roll angle estimator 80 includes bias cor- 
rection circuit 84 and an optional bias connection circuit 
87 for providing bias correction to the measured roll rate s 
signal 13 and lateral acceleration signal 15, respec- 
tively. Bias-correction circuits 84 and 87 may include a 
low-pass filter that produces an average value over a 
designated period of time which, for example, may 
include two minutes, and further subtracts the low-pass w 
filter output from the measured signal to produce the 
bias-corrected signals. 

[0020] Roll angle estimator 80 also includes an 
acceleration-based roll angle calculation circuit 88 
which receives the bias-corrected lateral acceleration is 
signal 15 and, in response thereto, calculates an accel- 
erometer-based roll angle. A rough road detection cir- 
cuit 90 monitors the acceleration-based roll angle and 
determines if a rough road condition exists that affects 
lateral side-to-side motion of the vehicle. This may be 20 
accomplished by rough road detection circuit 90 com- 
paring the acceleration-based roil angle with the previ- 
ous acceleration-based roll angle and the last 
determined roll angle, and, if there is substantial disa- 
greement in the comparison, it produces a rough road 25 
condition signal. A blending coefficient circuit 92 is pro- 
vided for generating a roll blending coefficient a R which 
determines the proportion of signal blending between 
the accelerometer-based roll angle calculation and the 
time-updated roll angle estimate which is partially 30 
derived from the sensed angular roll rate. If a rough 
road condition is detected, the blending coefficient a R is 
preferably set so that the roll angle estimate ignores the 
accelerometer-based roll angle calculation. 
[0021 ] The roll angle estimator 80 also includes an 35 
angular rate sensor/accelerometer blending circuit 86. 
Blending circuit 86 receives the bias corrected roll rate 
13' and the accelerometer-based roll angle, as well as 
the roll blending coefficient a R . Angular rate sen- 
sor/accelerometer blending circuit 86 contains a dis- 40 
crete-time blending algorithm which determines the 
overall roll angle estimate 82 as a function of the time- 
updated measurement angle estimator, the accelerom- 
eter-based roll angle, and the roll blending coefficient 
a R . The discrete-time blending algorithm is explained in 45 
more detail hereinafter. The roll angle estimate 82 pro- 
duced by roll angle estimator 80 provides an estimated 
value of the vehicle's roll angle about the horizontal axis 
of the vehicle only. While a single-axis roll angle estima- 
tor is shown and described herein, it should be under- so 
stood that the teachings of the present invention 
likewise provide for a single-axis pitch angle estimator 
which, instead of the input shown, preferably receives 
the pitch rate signal 17 and longitudinal acceleration 
signal 1 9 and determines a pitch blending coefficient a P 55 
and to estimate a pitch angle. 
[0022] Referring to FIGS. 3A and 3B, a dual-axes 
roll and pitch estimator 100 is illustrated therein. The 
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dual-axes roll and pitch estimator 100 includes the 
same features of the single-axis roll angle estimator 80 
shown in FIG. 2, with the addition of other features for 
providing a pitch angle estimate 84, and also provides 
other sensor inputs that may be employed in connection 
with producing the roll angle estimate 82 and pitch 
angle estimate 84. In addition to the roil rate signal 13 
and lateral acceleration signal 15, the dual-axes attitude 
angle estimator 100 further receives the longitudinal 
acceleration signal 19, vertical acceleration signal 21, 
yaw rate signal 27, and pitch rate signal 17, which are 
bias corrected via respective bias correction circuits 
102, 106, 108, and 114. Bias correction circuits 102, 
106, 108, and 114 may be configured similar to circuits 
84 and 87. Additionally, the dual-axes attitude angle 
estimator 100 employs an acceleration-based pitch 
angle calculation circuit 112 which receives the bias 
corrected longitudinal acceleration 19* and the bias cor- 
rected vertical acceleration 21', as well as a vehicle 
acceleration signal from the speed filter 110. A pitch 
rough road detection circuit 118 is provided and 
receives the acceleration-based pitch angle calculation 
to determine if a rough road condition exists with a lon- 
gitudinal back-to-front motion of the vehicle. This may 
likewise be accomplished by comparing the accelera- 
tion-based pitch angle with the previous acceleration- 
based pitch angle and the last determined pitch angle 
estimate, and if there is substantial disagreement in this 
comparison, it detects a pitch rough road condition. 
[0023] A blending coefficient circuit 1 20 is provided 
for determining a pitch blending coefficient otp, for use in 
determining the pitch angle estimate 84. An angular 
rate sensor/accelerometer blending circuit 122 is 
included for receiving the pitch blending coefficient a P , 
from blending circuit 120, as well as the accelerometer- 
based pitch angle calculation and a yaw induced pitch 
rate correction signal from yaw induced pitch rate cor- 
rection circuit 116. The angular rate sensor/accelerom- 
eter blending circuit 122 blends the received signals of 
the function of the pitch blending coefficient a P . The 
yaw induced pitch rate correction circuit 116 receives 
the biased corrected pitch rate, estimate roll angle 82 
and biased corrected yaw rate 27' which determines the 
amount of pitch rate induced by yaw, so that the yaw 
induced components can be subtracted from the pitch 
rate as a signal correction. 

[0024] In addition, the dual-axes roll and pitch angle 
estimator 100 further shown employing an airborne 
detection circuit 104 which receives the bias corrected 
longitudinal acceleration signal 19', bias corrected lat- 
eral acceleration signal, and the bias corrected vertical 
acceleration signal 21'. Airborne detection signal 104 
detects an airborne condition of the vehicle, which may 
then be used to generate the roll blending coefficient a R 
in blending circuit 92. The airborne determination is 
accomplished by comparing the magnitude of the vector 
sum of the three accelerometer signals 19, 15, and 21 
to a threshold value. The roll blending coefficient a R 
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may be set to a value to ignore the acceleration-based 
roll angle calculation during a detected airborne condi- 
tion, as well as during a rough road condition. 
[0025] Further, the acceleration-based roll angle 
calculation circuit 88 of estimator 100 is shown receiv- s 
ing the biased corrected lateral acceleration, as well as 
other inputs which include the vertical acceleration, yaw 
rate signal, and a vehicle speed signal 34 which is fil- 
tered via speed filter 110. Accordingly, the acceleration- 
based roll angle calculation may be determined based to 
on the lateral acceleration signal alone, or in combina- 
tion with other signals. 

[0026] It should be appreciated that the single-axis 
attitude angle estimator 80 shown in FIG. 2, and the 
dual-axes attitude angle estimator 100 shown in FIGS, is 
3A and 3B, can be implemented by the microprocessor 
control unit (MCU) 22 on sensing module 10. While indi- 
vidual features of the estimators 80 and 100 are 
explained as circuits, such features can be implemented 
in an analog circuit or performed by digital processing 20 
carried out in accordance with programmed algorithms. 
[0027] Accordingly, the dual-axes roll and pitch 
angle estimator 100 provides independent roll and pitch 
estimations, each of which preferably assumes the 
other angle is approximately zero degrees. The pitch 25 
and roll channels each use the blending scheme 
described herein to blend the appropriate angular rate 
signal with the appropriate acceleration-based angle 
estimate. In the roll channel, the acceleration-based 
angle estimate is derived under the assumption that a 30 
vertical gravitational acceleration is present, along with 
a horizontal lateral acceleration due to vehicle maneu- 
vering. In a steady-state circular turn, the magnitude of 
the horizontal acceleration is the product of the vehicle's 
yaw rate and vehicle speed. The vehicle's yaw rate 35 
could be estimated using the estimated attitude angles 
and the body-based angular rates, or can be approxi- 
mated using the body-based yaw rate sensor alone. 
With the earth-based horizontal and vertical accelera- 
tion estimates, the lateral and vertical accelerometers 40 
can be used to determine the acceleration-based roll 
angle estimate. 

[0028] In the pitch channel, the horizontal longitudi- 
nal acceleration is estimated using the derivative of the 
vehicle speed. The acceleration-based pitch angle is 45 
then derived using the vertical and longitudinal acceler- 
ometers. With the blending scheme, transient error 
present in the acceleration-based angle estimates are 
low-pass filtered, so the blending coefficient is adjusted 
to a value which is an optimal tradeoff between ignoring so 
these transient errors and having immunity to unknown 
angular rate sensor biases. Accordingly, the blending 
coefficients of a R and a P are variable in that they may 
be adjusted for transient errors or drift present in accel- 
eration-based sensors and angular rate sensors which 55 
are employed to provide the overall roll and pitch angle 
estimates. 

[0029] The signal blending according to the present 



invention includes recording a measurement-updated 
angle estimate, integration of the measured angular 
rate signal sensor to obtain a change in angle value and 
providing a time-updated angle estimate. The time- 
updated angle estimate is blended with the accelera- 
tion-based angle estimator to determine the angle esti- 
mate. The blending employed in the angular rate 
sensor/acceleration blending circuits 86 and 122 each 
provide for a discrete-time blending algorithm which 
may be represented by the following equations. 

♦Si-»£i+«(*w-»£i) 

[0030] Where $$1 is the time-updated angle esti- 
mate at time (k+1) which is equal to the measurement- 
update angle estimate ^ at the previous time instant 
(k) summed with the integration of the measured angu- 
lar rate. The measured angular rate integration is equal 
to the product of the measured angular rate P k and the 
discrete-time interval A which is the time period 
between k and k+1. As shown in the latter equation, the 
measurement-updated angle estimate +m at time 
instant (k+1) is derived by summing the time-updated 
angle estimate $$1 at time instant (k+1) with a 
blended proportion of the difference between the accel- 
erometer-based angle estimate <|>/? + i and the time- 
update angle estimate $$1 at time instant {k+1). 
Accordingly, the difference between the accelerometer- 
based angle estimate and time-updated angle estimate 
is multiplied by the blending coefficient a R or a P which 
may be variable between a value of 0 and 1 . 
[0031 ] It is preferred, that during either a rough road 
condition or an airborne condition, the blending coeffi- 
cient a be set to 0, so as to nullify an effect on the accel- 
erometers employed. Accordingly, either the time- 
updated estimate 4 $1 , when a equals 0, or the meas- 
urement-updated angle estimate . when a is not 
equal to 0, represents the overall angle estimate which 
is provided as the output of the blending process. 
Accordingly, the measurement-updated angle estimate 
<t>$ is used if a filtered estimate is desired, Le. t one 
which depends on data available up to an including time 
instant (k), while the time-updated angle estimate <t> $1 
is used if a predicted estimate is desired for only data 
prior to time instant [k+1). 

[0032] The acceleration-based roll angle and pitch 
angle calculations may be obtained from a lookup table, 
or can be computed as real time computations. It should 
be appreciated that there are various techniques availa- 
ble for computing an acceleration-based roll angle and 
an acceleration-based pitch angle that may be 
employed in connection with the present invention. As 
example, the acceleration-based roil angle calculation 
may be computed according to either of the following 
two equations: 
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<|>£ =-arcsin(A y /G) 

or 

$1 =-arctan(^j/G) 

where A y represents the measured lateral accel- 
eration, and G represents the earth's gravitational 
acceleration which is equal to approximately 9.81 
m/sec?. 

[0033J Likewise, as examples, the acceleration- 
based pitch angle calculation may be provided accord- 
ing to either of the following two equations: 

e£ = arcsin (AJG) 

or 

e£ =arctan(>A x /G) 

where A x indicates the measured longitudinal 
acceleration, and G equals the earth's gravitational 
acceleration. Accordingly, the acceleration-based roll 
and pitch angle calculations may be provided in accord- 
ance with the above-identified equations, or otherwise 
computed as known in the art. 
[0034] The blending scheme of the present inven- 
tion effectively integrates the angular rate sensed signal 
over the last time interval, adds it into the previous over- 
all angle estimate, and then slightly corrects the new 
estimate towards the acceleration-based angle esti- 
mate at the current time instant. The blending coeffi- 
cient a adjusts the fractional level of this correction such 
that, at the extremes, if a equals 0, the acceleration- 
based estimate is ignored, and if a equals 1 the angular 
rate sensed signal is ignored. If the blending coefficient 
a is small, errors in the acceleration-based estimate are 
effectively low-pass filtered. If the angular rate sensor 
and accelerometer agree on the rapidly-changing 
angle, there is no filtering lag associated with the blend- 
ing. In addition, an unknown angular rate sensor bias 
leads to a constant error in the overall angle estimate, 
instead of an ever-increasing error. Accordingly, the 
blending coefficient trades off between the bandwidth of 
the low-pass filtering of the acceleration-based estimate 
and the gain from the angular rate sensor bias to the 
consequent angular estimation error. The heavier the 
low-pass filtering, the larger the error produced by an 
unknown angular rate sensor bias. Accordingly, the 
blending coefficient may be allowed to vary in time, 
depending on the output of the rough road detection cir- 
cuit and the airborne detection circuit, and used to 
determine the overall attitude angle of the vehicle. 
[0035] Referring to FIGS. 4A-4C. a roll and pitch 
angle estimate methodology 130 is illustrated therein 
according to the dual-axes roll and pitch estimate 
approach of FIGS. 3A and 3B. In step 132, methodology 
130 reads the sensor signals including roll, pitch, and 



yaw rates, and longitudinal, lateral, and vertical acceler- 
ation signals, as well as vehicle speed. Next, methodol- 
ogy 130 filters the vehicle speed to provide for vehicle 
acceleration in step 134. 
5 The filtering may be accomplished by determining the 
derivative of vehicle speed. In step 136, the roll and 
pitch rate signals are biased corrected. In step 138, the 
yaw rate and longitudinal, lateral, and vertical accelera- 
tion signals are biased corrected using power-up or 
10 quiet period bias estimates. 

[0036] In step 140, methodology 130 obtains the 
attitude angle rates as a function of the measured roll, 
pitch, and yaw rates and the attitude angle estimates. 
This can be accomplished by using the yaw-induced 
18 pitch rate correction, according to one example. The 
estimate of earth-horizontal components of acceleration 
are determined in step 142, which includes the vehicle 
longitudinal acceleration A x , and vehicle lateral acceler- 
ation A y . In step 144, methodology 130 estimates the 
20 acceleration-based roll angle. This may be achieved by 
performing an arctangent calculation as set forth above, 
or may employ the atan 2 function as shown, which 
allows for a larger angular range of 0 to 360 degrees. In 
step 146, methodology 130 estimates the acceleration- 
's based pitch angle by performing an arctangent calcula- 
tion as set forth above, or by employing the atan 2 func- 
tion as shown in block 146. The magnitude of the total 
acceleration vector is then calculated as shown in step 
148. 

30 [0037] Referring to step 150, methodology 130 
compares the total acceleration magnitude to a prede- 
termined threshold to determine if the vehicle is air- 
borne. If the acceleration magnitude exceeds the 
threshold, an airborne condition is indicated in step 152. 

35 Otherwise, step 1 54 indicates that no airborne condition 
is present. Proceeding to decision step 156, methodol- 
ogy 130 determines if a rough road condition is present 
for vehicle roll. This achieved by checking whether the 
acceleration-based roll angle substantially disagrees 

40 with both the previous acceleration-based roll angle and 
the previous overall roll angle estimate. If this condition 
is met, a roll rough road condition is set in step 160. 
Otherwise, step 158 indicates that no roll rough road 
condition is detected. Similarly, methodology 130 pro- 

45 ceeds to decision step 1 62 to determine if a pitch rough 
road condition exists. This includes checking to see if 
the acceleration-based pitch angle substantially disa- 
grees with both the previous acceleration-based pitch 
angle and previous overall pitch angle estimate, tf so, a 

so pitch rough road condition is indicated in step 166. Oth- 
erwise, in step 164 no pitch rough road condition is indi- 
cated. 

[0038] Proceeding on to step 168, the roll blending 
coefficient is set to a nominal value of between 0 and 
55 1 . In step 1 70, methodology 130 checks for an airborne 
condition and. if an airborne condition is detected, pro- 
ceeds to step 172 to set the roll blending coefficient a R 
= 0. Thereafter, methodology 130 proceeds to step 174 
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to check if a roll rough road condition has been set and, 
if so, proceeds to step 176 to set the roll blending coef- 
ficient a R =0. 

[0039] Methodology 1 30 then proceeds to step 1 78 
to set the pitch blending coefficient <xp to a nominal s 
value of between 0 and 1. Proceeding to step 180, 
methodology 130 checks for an airborne condition and, 
if present, proceeds to step 1 82 to set the pitch blending 
coefficient a P ■ 0. Thereafter, methodology 130 pro- 
ceeds to step 184 to check if the pitch rough road con- 10 
dition has been met and, if so, proceeds to step 186 to 
set the pitch blending coefficient a P = 0. 
[0040] Thereafter, methodology 130 proceeds to 
step 188 to perform roil angular rate/acceleration blend- 
ing to give an overall roll angle estimate 82. Proceeding 15 
on, methodology 130 goes to step 190 to perform the 
pitch angular rate/acceleration blending to give the over- 
all pitch angle estimate 84 according to the present 
invention. Accordingly, attitude angle estimation meth- 
odology 1 30 produces both a roll angle estimate 82 and 20 
a pitch angle estimate 84 for the vehicle. 
[0041] It will be understood by those who practice 
the invention and those skilled in the art, that various 
modifications and improvements may be made to the 
invention without departing from the spirit of the dis- 25 
closed concept. The scope of protection afforded is to 
be determined by the claims and by the breadth of inter- 
pretation allowed by law. 

Claims 30 

1 . A method for estimating an attitude angle of a vehi- 
cle, said method comprising the steps of: 

sensing angular attitude rate (13) of a vehicle 35 
and producing an output signal indicative 
thereof; 

sensing one of lateral and longitudinal acceler- 
ation (15) of the vehicle and producing an out- 
put signal indicative thereof; 40 
producing an attitude angle estimate (82); 
updating said attitude angle estimate (82) as a 
function of said sensed angular attitude rate 
(13); 

determining an acceleration-based attitude 45 
angle (88) as a function of said sensed acceler- 
ation (15); 

providing a blending coefficient (92); and 
generating a current vehicle attitude angle esti- 
mate (82) as a function of said updated attitude so 
angle estimate (82), said acceleration-based 
attitude angle (88), and said blending coeffi- 
cient (92). 

2. The method as defined in claim 1 further compris- 55 
ing the step of detecting a rough road condition (90) 

of the vehicle, and adjusting said blending coeffi- 
cient (92) as a function of said rough road detection 



(90). 

3. Hie method as defined in claim 1 further compris- 
ing the step of detecting an airborne condition (104) 
of the vehicle, and adjusting said blending coeffi- 
cient (92) as a function of said detected airborne 
condition (104). 

4. The method as defined in claim 1 , wherein said atti- 
tude angle comprises a roll angle (82), said sensed 
attitude rate comprises an angular roll rate (13), 
and said sensed acceleration comprises a lateral 
acceleration (15). 

5. The method as defined in claim 1 , wherein said atti- 
tude angle comprises a pitch angle (84), said 
sensed attitude rate comprises an angular pitch 
rate (17), and said sensed acceleration comprises 
a longitudinal acceleration (19). 

6. The method as defined in claim 1, wherein said 
step of updating said attitude angle estimate (82) 
includes the step of integrating said sensed angular 
attitude rate (13) over a time period, and adding 
said integration with said attitude angle estimate 
(82). 

7. The method as defined in claim 1 , wherein said atti- 
tude angle estimate (82) comprises the vehicle atti- 
tude angle estimate at a previous time period. 

8. The method as defined in claim 1, wherein said 
step of generating said vehicle attitude angle esti- 
mate (82) further comprises multiplying said blend- 
ing coefficient (92) by the difference between said 
acceleration-based angle estimate (88) and said 
updated attitude angle estimate (82), and further 
adding said multiplication to said updated attitude 
angle estimate (82). 

9. The method as defined in claim 1, wherein said 
blending coefficient (92) has a value in the range of 
0to1. 

10. A vehicle attitude angle estimator for use in a vehi- 
cle, said vehicle angle estimator comprising: 

an angular attitude rate sensor (1 2) for sensing 
angular attitude rate (13) of a vehicle and pro- 
ducing an output signal indicative thereof; 
an accelerometer (14) for detecting one of lat- 
eral and longitudinal acceleration (15) of the 
vehicle and producing an output signal indica- 
tive thereof; 

a controller (22) for producing an attitude angle 
estimate (82) and updating said attitude angle 
estimate (82) as a function of said sensed 
angular attitude rate (13); said controller (22) 
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15 

determining an acceleration-based attitude 
angle (88) as a function of said sensed acceler- 
ation (15), said controller (22) further providing 
a blending coefficient (92) and generating a 
current vehicle attitude angle estimate (82) as 5 
a function of said updated attitude angle esti- 
mate (82), said acceleration-based attitude 
angle (88), and said blending coefficient (92). 

11. The vehicle angle estimator as defined in claim 10 10 
further comprising a rough road detector (90) for 
detecting a rough road condition of the vehicle, 
wherein said blending coefficient (92) is adjusted as 

a function of said detected rough road condition 
(90). is 

12. The vehicle angle estimator as defined in claim 10 
further comprising an airborne detector (104) for 
detecting an airborne condition of the vehicle, 
wherein said blending coefficient (92) is adjusted as 20 
a function of said detected airborne condition (1 04). 

13. The vehicle angle estimator as defined in claim 10, 
wherein said angular attitude rate sensor com- 
prises an angular roll sensor (12) for sensing angu- 25 
lar roll rate (13), and said accelerometer comprises 

a lateral accelerometer (14) for sensing lateral 
acceleration (15), wherein said controller (22) pro- 
duces a roll angle estimate (82) and updates the roll 
angle estimate as a function of the sensed angular 30 
roll rate (13), and said controller (22) determines an 
acceleration-based roll angle (88) as a function of 
the sensed lateral acceleration (15), said controller 
(22) further provides a roll blending coefficient (92) 
and generates a current vehicle roll angle estimate 35 
(82) by further updating the roll angle estimate as a 
function of the acceleration-based roll angle (88) 
and the roll blending coefficient (92). 



updating said pitch angle estimate as a func- 
tion of said acceleration-based pitch angle 
(112) and said pitch blending coefficient (120). 

15. The vehicle angle estimator as defined in claim 10, 
wherein said angular attitude rate sensor com- 
prises an angular pitch rate sensor (1 6) for sensing 
angular pitch rate (17) and said accelerometer 
comprises a longitudinal acceleration (18) for 
detecting longitudinal acceleration (19), said con- 
troller (22) producing a pitch angle estimate (84) 
and updating said pitch angle estimate as a func- 
tion of said sensed angular pitch rate (17), and said 
controller (22) determining an acceleration-based 
pitch angle (112) as a function of said sensed longi- 
tudinal acceleration (19), said controller (22) further 
providing a pitch blending coefficient (120) and fur- 
ther updating said pitch angle estimate (84) as a 
function of said acceleration-based pitch angle 
(112) and said pitch blending coefficient (120) to 
generate a current vehicle pitch angle estimate 
(84). 

16. The vehicle angle estimator as defined in claim 10, 
wherein said controller (22) generates said current 
vehicle attitude angle estimate by multiplying said 
blending coefficient (92) by the difference between 
the acceleration-based angle estimate (88) and the 
updated attitude angle estimate (82), said controller 
(22) further adding said multiplication to the 
updated attitude angle estimate (82). 



14. The vehicle attitude angle estimator as defined in 40 
claim 13 further comprising: 

an angular pitch rate sensor (16) for sensing 
angular pitch rate (17) of the vehicle and pro- 
ducing an output signal indicative thereof; 45 
a longitudinal accelerometer (18) for detecting 
longitudinal acceleration (1 9) of the vehicle and 
producing an output signal indicative thereof; 
and 

said controller (22) produces a pitch angle esti- so 
mate (84) and updates said pitch angle esti- 
mate as a function of said sensed angular pitch 
rate (17), and said controller (22) determines 
an acceleration-based pitch angle (112) as a 
function of said sensed longitudinal accelera- 55 
tion (1 9), said controller (22) further providing a 
blending coefficient (120) and generating a cur- 
rent vehicle pitch angle estimate (84) by further 
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READ SENSOR SIGNALS: 
ROLL, PITCH AND YAW RATES, 
LONGITUDINAL. LATERAL, AND VERTICAI 
ACCELERATES, AND VEHICLE SPEED 



FILTER VEHICLE SPEED TO 
PROVIDE VEHICLE ACCELERATION 



I 



ROLL AND PITCH RATE 
BIAS CORRECTION FILTERS 



BIAS-CORRECT YAW RATE AND 
LONGITUDINAL, LATERAL, AND VERTICAL 
ACCELERATIONS USING POWER-UP OR 
QUIET PERIOD BIAS ESTIMATES 



I 



OBTAIN ATTITUDE ANGLE RATES AS A 
FUNCTION OF MEASURED ROLL, PITCH 
AND YAW RATES AND ATTITUDE ANGLE 
ESTIMATES SUCH AS BY YAW-INDUCED 
PITCH RATE CORRECTION 



1 



ESTIMATE EARTH-HORIZONTAL 
COMPONENTS OF ACCELERATION 
A x = VEHICLE ACCELERATION 

A y = VEHICLE SPEED x YAW RATE 



I 



ESTIMATE ACCELERATION-BASED 
ROLL ANGLE 

0 a = afan2 (ay, g) - atan2 (a y . -a z ) 

WHERE g = GRAVITATIONAL ACCELERATION 
a y = MEASURED LATERAL ACCELERATION 
3*= MEASURED VERTICAL ACCELERATION 



I 



132 



134 



136 



138 



140 



142 



144 



ESTIMATE ACCELERATION-BASED PITCH ANGLE 

e a =atan2 la x . -a z ) -atan 2 la x . g) 

WHERE a x = MEASURED LONGITUDINAL ACCELERATION 



I 



CALCULATE MAGNITUDE OF 
TOTAL ACCELER ATION VECTOR: 
ACCELERATION =aJ a x 2 ♦ a y 2 7^2 
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AIRBORNE = YES 



-156 



NO 
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DOES ACCELERATION-BASED 
ROLL ANGLE 
SUBSTANTIALLY DISAGREE WITH 
BOTH PREVIOUS ACCELERATION-BASED 
ROLL ANGLE AND PREVIOUS 

OVERALL ROLL ANGLE 160 . 

ESTIMATE? 



YES 



ROLL-ROUGH-ROAD = NO 
1 



ROLL-ROUGH-ROAD = YES 



J 



NO 
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164 



162 

DOES 

^DOES ACCELERATION-BASED 
PITCH ANGLE 
SUBSTANTIALLY DISAGREE WITH 
BOTH PREVIOUS ACCELERATION-BASED 
PITCH ANGLE AND PREVIOUS 
OVERALL PITCH ANGLE 166 x 

ESTIMATE? A 



YES 



PITCH-ROUGH-ROAD = NO 



PITCH-ROUGH-ROAD = YES 
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ROLL-BLENDING-COEFFICIENTo< R s NOMINAL VALUE 
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ROLL-BENDING-COEFFICIENT o< R = 0 
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Fig.4C. 




ROLL-BENDING-COEFFICIENTo< R = 0 
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PITCH-BLENDING-COEFFICIENT o< p = NOMINAL VALUE 




PITCH-BENDING-COEFFICIENTo< pS 0 




ROLL ANGLE RATE/ACCELERATION 

BLENDING TO GIVE OVERALL ROLL 
ANGLE ESTIMATE 
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PITCH ANGLE RATE/ACCELERATION 

BLENDING TO GIVE OVERALL ROLL 
ANGLE ESTIMATE 
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